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REVISION 1 CHANGES 


This document is a revised version of the previous one entitled " Shuttle 
Unified Navigation Filter", dated November 1972, and supercedes that document. 
The major revisions consist of: 

• elimination of equations and variables associated with 
rectification criteria formerly utilized before each entry 
into state extrapolation routine, 

• add one-way Doppler measurement capability , 

• indicate manner in which Boost Phase will be incor- 
porated in the UNF , 

• expand capability of initializing filter with correlated 
weighting matrix to include rendezvous phase, 

• allow for retention of current crosstrack components 
when reinitializing filter weighting matrix . 



FOREWORD 


This document is one of a series of candidates for inclusion in a future re- 
vision of JSC -04217, 'Space Shuttle Guidance, Navigation, and Control Design 
Equations. 11 The enclosed has been prepared under NAS9-10268, Task No. 15-A, 
"GN&C Flight Equation Specification Support", and applies to function 3 of the 
Orbital Coast Navigation Module (ON2), function 2 of the Co-orbiting Vehicle Navi- 
gation Module (ON3), function 2 of the Approach and Landing Navigation Module 
(ON4), and functions 2 and 3 of the Final Approach and Landing Navigation Module 
(ON5), as defined in JSC-03690, Rev. D, r, Space Shuttle Guidance, Navigation, 
and Control Software Functional Requirements", dated January 1973. 



Gerald M. Levine, Director 
APOLLO Space Guidance Analysis Division 
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NOMENCLATURE 


Notational Conventions 

Upper case letters represent matrices (dimension 3x3 unless 
otherwise noted) 

Lower case and Greek letters reserved for scalars and vectors 

Vector quantities are underlined (column vectors (3 x 1) in ref- 
erence coordinates unless otherwise noted) 

AU switches not input are initially set to zero 

Average value indicated by superbar e.g. f$ c 


Symbol 

a Effective aerodynamic area of vehicle 

ap Equatorial radius of Fischer Ellipsoid 

a„ Semi-major axis of horizon measurement plane ellipse 

Angle between earth-fixed equatorial x-axis (through prime 
meridian) and reference equatorial x-axis 

a zQ Value of a z at time = t^ F 

b Number of measurement biases included in navigated state 

b d x 1 measurement geometry vector used in filter weighting 

vector and matrix calculations 

b F Polar radius of Fischer Ellipsoid 

hr* Semi-minor axis of horizon measurement plane ellipse 

H 

c Intermediate scalar in measurement update equations 
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Cq Vehicle drag coefficient 


C D0' C D1 


Coefficients in drag coefficient relation 


c i 


d 


Measurement code identifying the ith measurement type at a 
given measurement time 


c i 


0 


0.5 

1 

2 

3 

4 

5 


Measurement 

Range 

One way Doppler 
Range rate 
Angle ( 3 > 

Angle < 8 ) 

Altitude 

Drag 


A 

State dimension in given mission phase 


Relative to fixed 
point or target 


d 


H 


d 


x 


dum.dum 


dt, dt c 
f 


e H ,f H 


L 

G 

h 

h INDR 

S'lNDR 


Intermediate scalar used in Horizon Direction Routine 

Specifies weighting matrix dimension for extrapolation routine 
<d x *0 specifies no matrix extrapolation required) 

Dummy scalar, vector 

Time increments used in Kepler Routine 

Factor used in Doppler Equations ( i rJ v c ) 

Intermediate scalars used in Horizon Direction Routine 

Doppler transmitted frequency 

Index used to indicate number of ground beacons predicted in 
current beacon search interval 

Gravitation force /unit mass 

Gravity gradient matrix 

Vehicle altitude 

Altitude at which drag measurements are first processed 
Altitude at which drag measurements are no longer accepted 
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h INBAR 

h FBAR 

hp 

i 

I 

12 

^B.i 

x dum 
-pole 


Altitude at which baro- altimeter data are first processed 
Altitude below which no baro -altimeter data are processed 
Atmospheric density model scale height 
Angle between horizon position vector and sun vector 
Index 

Identity matrix 

Unit vector normal to horizon measurement plane 

Intermediate 3calars used in angle measurement calculations 

Code identifying ground beacon(s) found during search interval. 
Takes on values 1 through n^ depending on place beacon 
occupies in the stored list 

Dummy scalar used in orbital period calculation 

Unit vector along earth's polar axis 

Unit vector along primary vehicle position vector 


i re3 Dummy variable reserving index i in beacon search 

i^jj Unit horizon position vector 

— RW Unit vector directed parallel to runway centerline (in earth 

fixed coordinates) 



Unit vector along 


- x'-iy’^z 


Unit vectors used to define local vertical coordinate system 
(also used as dummy unit vectors) 
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xm* 




i-pH 

j 

J 2* J 3' J 4 
k 

V k l 


k(flr 2 ) 

1 

m 

m D 

M EF-R 


m r-lv 


Unit vectors defining sensor coordinate system 

Unit vector along vehicle longitudinal axis 
Unit vector along £ 

Unit vector along pa 
Unit vector along 
Index 

Gravitational harmonic coefficients 
Index 

Input constants used in W- matrix reinitialization (phase 4) 

Takes on value kg at first VOR (or DME) data good and k^ 
at first MLS data good 

Constant used in predicting value for universal variable x 
Factor used in correlated W- matrix initialization (phase 0) 
Index 

Mass of vehicle 

Doppler frequency multiplying factor 

Transformation matrix from earth fixed to reference coor- 
dinates 

Transformation matrix from reference to local vertical 
coordinates 
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M LV-R Transpose of M R _ Ly 


M 


R-H 


Transformation matrix from reference to horizon coordinate 
system 


M R-M 


Transformation matrix from reference to navigation sensor 
coordinates 


n R Total number of ground beacons (input) 

Number of measurements to be sequentially incorporated at 
a given measurement time and mission phase 


n Nautical miles to feet conversion factor 

mtt 


°W 


Desired number of accelerometer read cycles between W-matrix 
extrapolations (phase 4) 


n At 


Count of accelerometer read cycles (At ) between W-matrix 

cL 

extrapolations (phase 4) 


n TGB* 

n rHS 


Number of orbital periods between W-matrix reinitializations 
in ground beacon, horizon sensing navigation modes 


Dummy variable representing or n rR g 


P 


q i 


Indicates current navigation mission phase 
£ Navigation Phase 

0 On-orbit 

1 Rendezvous 

2 Braking 

3 Station- Keeping 

4 Entry, approach, landing 

5 Boost 

Value of ith measured parameter at a given measurement time 


On board estimate of measurement value 


q PN 


Process noise acceleration 


r Vehicle position vector (intermediate) 


x 



r<» 

-B 

-Bn 

£ B.j 

r 

—con 

rd 

r E 


Vehicle position vector in horizon coordinates 

Ground-based sensor position vector used for current navigation 
update 

Position vector (earth fixed coordinates) of current ground beacon 
to be interrogated 

Intermediate ground beacon position vector used in beacon search 
Conic vehicle position vector used in Kepler Routine 
Radians to degrees conversion factor 
Average earth radius 


«3 i p , 
res Vp, 
res r p4 
res r , 
res Xb 


Dummy variables used to reserve _i , v f r # r , Vg in Doppler 
measurement incorporation 


r ET 


Earth radius at nominal touchdown point 



Earth radius used in Precision Extrapolation Routine 

Horizon position vector in horizon coordinates 

Position vector of target vehicle w. r. t. primary vehicle in 
local vertical coordinates (phase 3) 


r p Primary vehicle position vector (permanent) 

r Relative position vector (fixed point or target w.r.t. primary 

-P 

vehicle) 


Tp Magnitude of 

r ^ Relative range rate 

r . Ground-based sensor position vector (earth-fixed coordinates) 

a, J 

associated with given measurement (phase 4) j = 0, 3. . . 3n M 

— sun Sun position vector w. r. t. earth center 

r rj. Target vehicle position vector (permanent) 

— TD Position vector at location of nominal touchdown point (phase 4) 

Input in earth-fixed coordinates, converted to reference. 

j Ground beacon position vector (earth- fixed coordinates) stored 

in input list, (j = 1, 4. . 3n fi -2) 


The following parameters are switches set to "O' 1 or "l". The 
setting is defined below with the "0“ setting the corresponding negation. 

Switch 

s Accelerometer biases are estimated (phase 4) 

cL 

s att No update is performed after precision extrapolation 

of state. This mode used in pointing horizon sensor. 


3 beacon 

S CTW 


Angle measurement is from MLS azimuth radar 

Ground-based sensor(s) are used in this phase 

Retain crosstrack position, velocity and associated correlation 
when reinitializing W- matrix 



s 


DG. 


Switch indicating measurement data from ith source is to be 
incorporated 



Horizon angle or ground beacon measurements 
for baro-altimeter measurement 
for elevation- angle from MLS 
flare elevation radar 
for elevation angle from MLS 
glide -slope elevation radar 
for range from MLS ranging radar 
for range from DME 
for azimuth angle from MLS 
for azimuth angle from VOR 


’DV 


Velocity correction data is to be processed (phase 3) 




Signifies first reception of VOR or DME data 


fPi 


Signifies first reception of MLS data 


’fp 




Signifies either or s fp has just been set to 'T 

Signifies first reception of drag measurement 


’fpD 


Signifies s f has just been set to 1 1 1 

iPn 


s init 


Signifies first entry intoUNF program in a new phase 


S LVWP(T) matrix initialization values have been input in local vertical 
coordinates for primary (target) weighting matrix 

8 perm Permanent state vector is to be extrapolated after a search 
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s rendW 

s search 

s atrt 

a T 

S TPI 

3 TPM 
S r 

s Wcorr 

s xD 

3 xt 

s xTAC 


Utilize automatic W-matrix reinitialization (phase - 1) 

Perform search for (a) ground beacons, (b) UV horizon 
or (c) target vehicle 

The sunlit horizon is being entered 

Include target vehicle state in estimation state 

Terminal phase initiation maneuver has been performed 
(phase 1) 

Perform W-matrix reinitialization (post TPI) 

After calculating orbital period, return to entry point 

Insert correlation into initialized W-matrix 

Perform no more drag measurement navigation updates 

Inhibit crosstrack navigation updates (ground beacon navigation) 

Perform no more VOR or DME navigation updates (first MLS 
data good has been received) 


Extrapolate states and W-matrix to start of Doppler count interval 
(t M * > 


The following switches take on multiple values as defined: 


s , Used to indicate when 3 rendezvous navigation marks have been 
count 

processed following a W-matrix initialization inhibit (phase 1) 


3 pert 


Used in Precision Extrapolation Routine 


’O' 

conic extrapolation 

•1* 

include 

h 


include 

j 2 . j 3 . j 4 
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.'O' No process noise included in W- matrix extrapolation 

'1' Place i n 3 acceleration components of W 

•2' Place i n crosstrack acceleration component of W 

'1' Indicates horizon sensing navigation; is then used 

to convert horizon threshold error variance to equivalent 
angle variance 

Sine of angle above horizontal at which ground beacon is 
’Visible". 

Angle between £ sun and a terminator position vector 
Time associated with state vector (r, v) 


Time of predicted acquisition of most recent beacon found in 
search 

Time of acquisition of jth beacon in search 

Time increment before a rendezvous maneuver in which naviga- 
tion is not performed 

Current time 

Time associated with conic state extrapolation in beacon search 
routine 

Time associated with a zQ 

Time of predicted rendezvous maneuver execution 



Limiting time in given beacon search interval 

t M Time associated with navigation measurement {also used as 

final precision state extrapolation time during search mode 
1 and horizon sensing attitude mode) 

*maxW Value of accumulated W- matrix extrapolation time beyond 
which W-matrix reinitialization is forced 


*Mprev 



hjv 


*Wcrit 

*xP 

V 

UNF 


v 


Time of previous navigation measurements 

Time associated with permanent state vectors (£p, Vp) 

Dummy variable to reserve t 

Time at which a given navigation phase is to be initiated 
Time associated with permanent state vectors (r^, v,j,) 
Predicted time of next visible UV horizon 

Value of accumulated W-matrix extrapolation time beyond which 
W-matrix reinitialization is requested 

Time prior to rendezvous maneuver beyond which W-matrix 
reinitialization is inhibited 

Dummy variable used to reserve t p 

Time associated with estimated biases (if t = 0, biases 
are constant) 

Abbreviation for Unified Navigation Filter 
Vehicle velocity vector (intermediate) 


xvi 



-B 


Ground beacon inertial velocity vector 


—con 

-L 


IP 


V RHI’ 

v RLO 


— RT 


Speed of light 

Conic vehicle velocity vector used in Kepler Routine 

Velocity vector of target vehicle w. r. t. primary vehicle in 
local vertical coordinates (phase 3) 

Primary vehicle velocity vector (permanent) 

Velocity limits around Mach 1.0 between which no baro-alti 
meter data should be processed 

Vehicle velocity vector w. r. t. touchdown point 



v 


P 


v oprev 


— T 


W 


w. 


1.3 


*i.j 


w 


sub 


Relative velocity vector (fixed point or target w.r.t. primary 
vehicle) 

Magnitude of v p 

Value of v in previous time step ( At a ) 

r** 

Target vehicle velocity vector (permanent) 

Filter weighting matrix (dimension d x d) 

Elements of W (numbered as in Figure 2 ) 

Vector partition of W 

b x d partition of W which is extrapolated 
d x 1 navigated state vector 


x, 


Universal conic variables 


xvii 



-M 

z 


O' 




Horizon sensor boresight axis (unit vector) 

Intermediate d x 1 vector used in measurement incorporation 
Angle of attack 

Value of ot in previous time step (At a ) 

A priori filter measurement error variance used for incorpora- 
tion of current measurement type 

A priori random angular momentum error variance 

A priori random drag measurement error variance 

A priori random energy error variance 

A priori random baro- altimeter measurement error variances 

A priori random horizon threshold error variance 

A priori random range measurement error variance 

A priori random range rate measurement error variance 
(fps)^, or Doppler measurement error variance (counts)^ 


2 2 


B 

P 


A priori random measurement error variances for set of 
orthogonal gimbal angles 


Angle measured in general coordinate system ( i , i ,i ) 

-xm’-ym-zm' 


Vehicle ballistic coefficient 


xviii 



y 

Z 




H 


Aq 

At 

At, 

c 

At 


B 


At 


At 


M 
At W 


At 


A 


T 


Ax 

Av 

i 


3 


Intermediate scalar used in filter weighting matrix update 

Intermediate b x 1 vector representing bias partition of 
measurement geometry vector (Ja) 

b x 1 vector representing measurement bias estimates 
(permanent) 

Horizon altitude 

Angle above horizontal at which ground beacon is "visible” 
Measurement residual 

Time increment of W- matrix extrapolation (phase 4) 

Minimum time interval between accelerometer reads (phase 4) 
Time increment allotted for deorbit maneuver preparation 
Doppler count interval 

Minimum time interval between measurements 

Total time filter weighting matrix has been integrated since 
last initialization 

State extrapolation time interval (phase 3) 

State extrapolation time interval (phase 4) 

Incremental update of state x (dimension = d x 1) 
Accelerometer-sensed velocity change 
Unit vector normal to current orbital plane 


xix 



€ 

P 

p o 

£a 


£dd 

P DD 


— H 


a? 


'prev 

£t 


Intermediate scalar set to 1 for W-matrix initialization and 
k(a ) for reinitialization (phase 0) 

Angle measured in general coordinate system A zm > 

Transfer angle of target vehicle in time interval At (phase 3) 

Earth's gravitational constant 

Elevation angle to horizon 

Atmospheric density 

Sea-level density of atmosphere 

Projection of r. on i - i „ plane of sensor coordinate 
J — p — xm — z m 

system 

Magnitude of p a 

■ ■ ♦ • 

Relative inertial acceleration vector (r^ - x Q ) 

Relative acceleration magnitude 
Position vector from vehicle to horizon 
Magnitude of £h 

in horizon coordinates 
Value of p from previous time step (At ) 

A 

Position vector from nominal touchdown point to vehicle 



xx 



The following parameters (a ) represent a priori inputs for W-matrix 
diagonal components: 

Reinitializing value for in plane position components (primary vehicle) 


rF 


rFCT 


rFT 


rFTCT 


rl 


rICT 


rIT 


rlTCT 


vF 


vFCT 


vFT 


vFTCT 


vl 


vlCT 


vIT 


Reinitializing value for crosstrack position component (primary vehicle) 
Reinitializing value for in plane position components (target vehicle) 
Reinitializing value for crosstrack position component (target vehicle) 
Initial value for in plane position components (primary vehicle) 

Initial value for crosstrack position component (primary vehicle) 

Initial value for in plane position components (target vehicle) 

Initial value for crosstrack position component (target vehicle) 
Reinitializing value for in plane velocity components (primary vehicle) 
Reinitializing value for crosstrack velocity component (primary vehicle) 
Reinitializing value for in plane velocity components (target vehicle) 
Reinitializing value for crosstrack velocity component (target vehicle) 
Initial value for in plane velocity components (primary vehicle) 

Initial value for cross track velocity component (primary vehicle) 

Initial value for in plane velocity components (target vehicle) 


(7 Initial value for crosstrack velocity component (target vehicle) 

vITCT 


a yi (bx 1) 

£y F (bx 1) 


Initial, reinitializing value(s) for b bias components 
Orbital period 


xxi 



0 


Pre-loaded horizon direction azimuth angles in vehicle local 
horizontal frame, measured counterclockwise from forward 
direction 


± 


,(H) 


Horizontal vector in horizon measurement plane indicating 
azimuth direction of sensed horizon 

0 in horizon coordinates 


* 


b x b transition matrix for bias components of navigated 
state vector 




*RV’ *VR 


Elements of (j - 0, 1. . . , b -1) numbered along rows 

3x3 submatrices of the relative state transition matrix (phase 3) 


* 


Ui 


— E 


W LS 
0 J T 


Angle measured by horizon sensor (between horizon and x ) 
Navigation filter weighting vector (dimension = d x 1) 

Earth’s angular velocity vector 

Vehicle to ground beacon line of sight rate 

Angular velocity of target vehicle (phase 3) 

t 


xxiL 



Special Notation 

|a| Magnitude of vector a 

( Transpose of ( ) 

unit(a) Unit vector of a = a/ |a| 

sign( ) Algebraic sign of ( ) with magnitude of 1 

Vector components begin with subscript "zero" (MAC notation) as opposed 
"one" (HAL notation). 
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INTRODUCTION 


Equations designed to meet the navigation requirements of the separate shuttle 
mission phases are presented in a series of reports entitled, "Space Shuttle GN fie C 
Equation Document" (Ref. Id to Ihh The development of these equations is based 
on performance studies carried out for each particular mission phase (Ref. 2 con- 
tains an extensive bibliography of these studies). Although navigation equations 
have been documented separately for each mission phase, a single unified naviga- 
tion filter design is embodied in these "separate" designs. The purpose of this 
document is to present the shuttle navigation equations inaform in which they would 
most likely be coded-as the single unified navigation filter used in each mission 
phase. This document will then serve as a single general reference for the naviga- 
tion equations replacing each of the individual mission phase navigation documents 
(which may still be used as a description of a particular navigation phase). 

GENERAL DESCRIPTION 

Fundamental characteristics of the navigation filter are as follows: 

1. Recursive formulation of the Kalman filter 
providing minimum variance estimates 

2. The square root formulation (W- matrix) of 
the state covariance matrix is used to provide 
greater computational accuracy and guarantees 
the covariance matrix to be at least positive 
semi -definite 

3. The W- matrix is periodically reinitialized to 
compensate for unmodeled errors and provide 
independence of mission length 

4. State process noise is utilized in selected short 
term applications (thereby allowing a very 
simply mechanized formulation) 

5. Measurements are sequentially incorporated 
(avoids matrix inversion and provides flexibility 
with respect to number of measurements) 

In the unified formulation, the filter has the following features: 

1. Provides for estimation of the shuttle state 
(6 dimensions) plus (b) measurement biases 

(b 3 0, 1, n where n will most likely be no 

greater than 4) 
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Provides for estimation of a target vehicle 
state (6 dimensions) if analyses establish the 
need for one in any phase. 

The flow diagrams presented in this document 
show the target state included in the estimated 
state vector (s^. - 1) for the "rendezvous" 
phase only. To date, it has not been firmly 
established that estimation of the target state 
is required in this phase (depends on target state 
ephemeris uncertainties), but is shown here to 
illustrate how target state estimation would be 
accommodated in the unified filter. This feature 
would be mandatory if it is desired that the shuttle 
have the capability to perform orbit navigation via 
the "ejected satellite" scheme (Ref. 3). By pro- 
viding for target state estimation in the unified 
filter, the option is left open for utilizing this unique 
orbit navigation scheme, which has distinct advan- 
tages over conventional on board orbit navigation 
systems. 

3. Uses only the number of variables required for the 
state dimension of a given phase. Thus, the extra 
locations reserved for the maximum dimension phase 
are available for other purposes if required in a dif- 
ferent phase. Figure 1-1 illustrates state vector defi- 
nitions and dimensions for each navigation mission 
phase. Figure 1-2 presents the basic covariance matrix 
definition and illustrates the W- matrix component 
numbering scheme used in the variable dimension 
feature. The target submatrix (W gu ^) is simply 
deleted for phases in which it is not required, and the 
bias submatrix column dimension has the dimension 
(b) associated with the mission phase. The row di- 
mension is appropriate for target state phases and 
the value of b. 
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Orbit Na 
Ground 
Beacon 

-vigation 

Horizon 

Sensing 

Rendezvous (or 
ejected satellite 
orbit navigation) 

Braking 

Station- 

Keeping 

F"""" 

Entry, 

Approach^ 

Landing 

Boost 

State ( 

Vector \ 
(x) ] 

(dxl) 

-o\-p 
-3 Vp 

f 8 / Dop- 

pier 

Bias 

\ x c / horizon 
\ 7 bias 

l*°\ 

*3 \ 

*6 

x 9 

H 

\— 13? 

r 

-P 

v 

r 

J biases 

-T 

-T 

/-°\ £ P : 

-3| ip 
^ 9 /) biaSeS 

\xg/| bia3e ^ 

1 

feo\ ip 

-31,-p 
x gl) biases 

l*°\ 
1*6 ) 

\x 9 / 

Dimen- 
sion (d) 

7 

7 

16 

10 t 

10* 


10^ 


r 


i 



= primary vehicle state (shuttle) 
= target vehicle state 



relative state 


*This dimension would be 10 unless (1) analyses prove the need to estimate the 
target state, or (2) the ejected satellite navigation capability is desired. 


^Provision is made for inclusion of biases in the navigated state, but the 
need for bias estimation (and the number of biases) can not be firmly 
established until the actual sensor error models are established. 


Figure 1 - 1 . State Vector Definitions 


1-3 




1-4 


W (square root 
of covariance 
matrix) 


E £ 

/ EP 
/ (6X6) 

1 

j 

i 

6 x b 

1 6x6 

i 

| 

(Filter covariance 

b X 6 

1 

1 

bx b 

1 b x 6 

matrix) 


1 

T~ 

— 

1 E_ 



i 




\ 6x6 

I 

6 x b 

1 (6x6) 


E * Shuttle covariance matrix 

* A _ 

E^ = Target covariance matrix 

b * Number of measurement biases 
included in state 


\ 


/ 


i 



w eub 
(6 x d) 
(shuttle) 


! Bias 
partition 
(b x d)‘ 


(6 x d) 
(target) 


Figure 1-2. W Matrix Definition 
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Considers seven possible measurement types for all phases: 
Range 

Doppler count 
Range rate 


Drag 
Altitude 

5. All angle measurements are unified, requiring only 

separate definitions of sensor "axes" (l_ xm # .iy m ' 

i ), The basic sensor angles included in the unified 
— zm 

filter are illustrated in Figure 1-3. 

6. The unified filter provides the i.^vigation capability 
for shuttle mission phases (p) defined as follows: 


Navigation Mission Phase * £ 

Orbit navigation 0 

Rendezvous 1 

Automatic braking 2 

Station-keeping 3 

Entry, approach and landing 4 

Boost 5 


Sensor angle (£) 
Sensor angle (6) 


] 


Relative to fixed point 
or target vehicle 


a. Orbit Navigation (Phase 0) 

The purpose of the Orbit Navigation phase is to provide a 
means of automatically reducing uncertainties in the on-board knowledge of the 
shuttle inertial state by accepting and processing data from the navigation sensor(s) 
This knowledge is required to (a) accurately compute orbital maneuvers, (b) 
provide accurate initial conditions for other mission phases such as rendezvous, 
deorbit and landing. . 

There are several candidate orbit navigation systems for the 

shuttle mission, e.g. : 

1. horizon sensing 

2. tracking ground based beacons 

3. tracking navigation satellites 

4. tracking satellites ejected from 

the primary vehicle. 


One mission phase, docking, has not been included in this list since 
this phase does not currently utilize filtering of navigation data. 
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STANDARD DEFINITION OF SENSOR 
ANGIES \@, 6 } 

- 180 * <0 <* 180 * 

-! 8 O *<0 < * 180 * 







NOTE: Axes in a figure on the right are parallel to the 

axes in the corresponding figure on the left. 

Figure 1-3. Navigation Sensor Coordinate Frame 
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The navigation equations required for systems (3) or (4) fall in the category of 
rendezvous navigation (phase 1). This document will present the equations required 
for horizon sensing systems and a ground beacon orbit navigation system. In the 
horizon sensing system, the direction of the line-of -sight to a horizon is measured 
with respect to inertially fixed coordinates provided by the inertial measurement 
unit (IMU). Equations are included which provide the attitude control system with 
inputs required to direct the sensor to the appropriate horizon according to a pre- 
determined schedule of azimuths (0). In the ground beacon system, transponders 
located at known positions on the earth are interrogated by the shuttle navigation 
system. The return signals from the transponders provide range to the beacon 
and/or range rate relative to the beacon. Provision is also made to process one 
way Doppler count. Also included are equations required to predict which of the 
ground beacons stored in a catalog will be encountered next and at what times the 
encounters will occur. The logic equations around a H UV Horizon Prediction Rou- 
tine M (TBD) are provided in order to yield a prediction of the time of the next visible 
UV horizon pass, for use in the horizon sensing navigation mode 

With minor modifications, the equations presented for these 
two systems (horizon sensing and ground beacon tracking) may be readily adapted 
to other orbit navigation systems, such as known or unknown landmark tracking, 
or to systems using different navigation sensors, e.g. radar altimeter. 

b. Rendezvous Navigation (Phase 1) 

Phase 1 of the UNF provides a means of automatically and 
autonomously improving on-board knowledge of the relative state between the shuttle 
(primary vehicle) and another orbiting vehicle (target vehicle). This knowledge 
would be required in (a) rendezvous missions as inputs to rendezvous targeting 
programs to compute maneuvers which effect rendezvous between the primary and 
target vehicles or (b) orbit navigation modes which utilize tracking of navigation 
satellites or satellites ejected from the primary vehicle. Rendezvous navigation 
sensor data consists of measurements of some portion of the relative state. Rela- 
tive range, range rate, and line-of-sight angles (p,6) (or any combination of these 
parameters) are the possible measurements accepted by the UNF in this phase. 

c. Automatic Braking Navigation (Phase 2) 

The purpose of the rendezvous terminal phase is to auto- 
matically bring the shuttle within the desired station- keeping boundaries relative 
to the target vehicle at a relative velocity commensurate with station- keeping 
guidance requirements. To accomplish this task, targeting and guidance functions 
must be supported by relative state navigation. The terminal phase i3 initiated 
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subsequent to the last midcourse maneuver (phase 1) at a relative range on the order 
of three to five miles. 

Phase 2 of the UNF is essentially a continuation of phase 1 
with respect to navigation equations and sensor measurements. Current analyses 
indicate that the target state need not be estimated, and a simple process noise 
model may be used in place of W- matrix reinitializations to account for modeling 
errors (e. g. maneuver uncertainties). Studies are underway to determine if com- 
putational inaccuracies will dictate carrying a relative state as opposed to subtract- 
ing two inertial states. If this proves more efficient, phase 2 navigation will simply 
merge into phase 3 navigation with no need for two separate phases. 

d. Station- Keeping Navigation (Phase 3) 

As in phase 1 or 2, the purpose of the station- keeping naviga- 
tion phase is to determine the state of the active vehicle, i. e. the one performing 
the station-keeping maneuvers, with respect to the target vehicle. A low eccentri- 
city orbit is assumed for the target vehicle. The fundamental difference between 
this phase and phase 2 is that the relative state is utilized as the navigated state. 
Typical values of relative range are 1000 ft or less, so that computational inaccur- 
acies may preclude subtracting ‘the primary vehicle state from the target state to obtain 
the desired relative state. 

e. Entry, Approach and Landing Navigation (Phase 4) 

The purpose of the entry navigation system is to provide up- 
to-date estimates of the shuttle state, i.e. the vehicle’s position and velocity, during 
the entry, transition, cruise, approach, and landing phases of the mission. This 
information is required to guide the vehicle to the terminal area and on to a safe 
landing. 

The entry phase is considered to start when the vehicle reaches 
an altitude of 400, 000 ft. Significant aerodynamic forces on the vehicle first occur 
at an altitude of about 300, 000 ft. During the period of flight from altitudes of about 
300,000 to 150,000 ft there will be a radio-transmission blackout because of the 
plasma sheath around the entry vehicle (Ref. 4). When the vehicle’s altitude is be- 
low 150,000 ft, it should be possible to obtain navigation updates from the PRS which 
is operated at S-band frequencies (2. 2 GHz). At altitudes below 100, 000 ft navaids 
such as VOR/DME or TACAN can be used to provide state-vector updates. Finally 
at altitudes below 30, 000 ft, terminal- phase navigation systems such as the AILS 
and MLS may also be used. 
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This phase is primarily concerned with navigation during 
the period of flight from an altitude of 400, 000 ft (entry interface) to touchdown. 

The primary navigation sensor during the mission phases of interest is the inertial 
measurement unit (IMU), which measures changes in vehicle caused by non-gravi- 
tational forces. The navigation equations required for state-vector updating using 
IMU data alone are given in Ref. lb. 

This document presents T a set of equations that can be used to 
update IMU-derived state estimates during the mission phases from entry through 
landing with drag, VOR/DME, baro-altimeter, and MLS measurement data. With 
minor modifications TACAN data could be used in place of that from VOR/DME, 
and AILS data could be used instead of that from the MLS. The navigation routine 
is structured so that PRS range measurements could be used in place of VOR/DME, 
AILS!, and MLS with a small number of changes. Simulation results to demonstrate 
navigation performance are given in Refs. 5-9. 

f* Boost (Phase 5) 

This phase is essentially identical to phase 4 (Entry) with 
one way Doppler measurements to ground stations (or satellites) included as the 
navigation measurement. The state dimension will probably include 3 platform 
misalignment angles and a Doppler bias making the total dimension 10. This slight 
addition to phase 4 has not been included in this document as yet. This does not 
represent a significant change and will be incorporated if this boost navigation is 
baselined. 

The unified navigation filter is structured as the basic naviga- 
tion "subroutine" serving each mission phase within which appropriate switches 
and inputs are preset or generated. The main navigation program may be designed 
to cycle automatically from one navigation phase to the next. As an illustration 
of a possible sequencing scheme. Figure i-4 is presented showing the cues which 
might be used to announce the entrance into a new navigation phase and the subse- 
quent call to the unified navigation filter ("callUNF" box). 




Figure l-4a, Navigation Mission Phase Sequencing 
(Tvoical rendezvous mission) (Sheet 


1 







Figure l-4b. Navigation Mission Phase Sequencing 

(Typical rendezvous mission) (Sheet 2 of 2) 
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FUNCTIONAL FLOW DIAGRAM 


A functional flow diagram of the UNF is presented in Figures 2-la and 2-lb. The 
program is initiated (Figure 2-la) , at a specified start time tg for all phases except 
entry where initiation occurs between accelerometer read times external to the 
UNF. Because of: 

» 

a. synchronization with accelerometer reads, 

b. state extrapolation during specific force sensing, and 

c. possibility that W- matrix and state extrapolation not 

using same cycle time, 

the entry phase follows a path separate from the other phases in the initial portion 
of the program (Figure 2-la) .Following the accelerometer read at time t M in the 
entry phase, the vehicle state is extrapolated to time t M ’ The estimated vehicle 
altitude is compared to altitude threshold values to determine if drag or baro-alti- 
meter data is to be incorporated. Also data good signals are interrogated for VOR, 
DME and MLS systems. If none of these criterions is met, the accelerometer 
read cycle is continued. If good measurement(s) are available, the appropriate 
sensors are read (except for the drag measurement which is basically the accelero- 
meter output) and the total number of separate parameters measured is computed 
(n^j). A check is made to see if the W- matrix is to be initialized, extrapolated or 
left alone and the flow joins the other phases for the functions shown in Figure 2- lb. 

For phases other than entry, the vehicle state (or states in the case of rendez- 
vous situations) are precision extrapolated to tg after waiting until current time 
is a minute prior to tg . At this point a search mode is entered on the initial call 
to the UNF program or any subsequent time the program is called from an external 
program. The purpose of this mode is to achieve lockon of a target vehicle in the 
rendezvous phases (p = 1, 2, 3), predict the time of the next visible UV horizon (at 
a prescribed horizon azimuth) in the horizon sensing orbit navigation mode, or pre- 
dict the time(s) of first visibility of ground beacons in the ground beacon orbit navi- 
gation mode. (The reason for entering the search mode at subsequent program en- 
tries is that Av maneuvers may be performed which will require a new search for 
the target or negate previous predicted horizon or ground beacon intercept times). 
When the search is completed in either rendezvous phases or ground beacon orbit 
navigation mode (i.e., the target is being tracked or the next ground beacon intercept 
time has been predicted), appropriate navigation sensors are read. ( \l/ in 
Figure 2 -la.) . V 
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The horizon sensing mode follows a slightly different path following the pre- 
diction of the next visible UV horizon because of the need to supply data to the atti- 
tude control system, so that the horizon sensor may be pointed at the predicted hori- 
zon at the predicted time t yv . After waiting until the current time is 1 minute 
prior to , the vehicle state is precision extrapolated to time t^y , the esti- , 
mated direction to the prescribed horizon is computed, and fed to the attitude con- 
trol system to point the horizon sensor. At this point the navigation sensor is read 
( in Figure 2- la) as in the other modes. 

After reading the navigation sensor(s) and the time t^ associated with the 
readout, the total number of measured parameters is computed (n M >. The vehicle 
state(s) and the W-matrix (except on first entry into the program) are precision 
extrapolated to measurement time tj^. A check is made to see if the W-matrix is 
to be initialized and the flow for these phases joins the entry phase for the functions 
shown in Figure 2-lb. 

Referring to Figure 2 -lb, if any non-constant biases are estimated, they are 
extrapolated to time t M . A this point, n M measurements are incorporated se- 
quentially in the following manner: for the ith measurement type, a "relative state 
and unit vectors along "sensor axes" are computed (except drag and altitude); the 
measurement geometry vector (b), measurement residual (Aq) and filter sensor 
variance ( a"^) are computed. This measurement is then incorporated in the cur- 
rent estimated state vector and W-matrix. 


Current time is then compared with mission event times and the UNF program 
is exited to the program sequencer if other functions are required (e.g. maneuver 
targeting or execution), or entry into a new navigation phase is called for. If pro- 
gram exit is not called for, navigation is continued after waiting a discrete time in- 
terval (preset for each individual navigation phase). The entry phase cycles back 
to accelerometer read ( Yi7 ) and rendezvous phases cycle back to navigation sen- 
sor read V- The horizon sensing mode selects a new horizon azimuth (if sched- 
duled) and calls the attitude control system to point the sensor in the estimated hori- 
zon direction (if the new direction is out of the sensor field of view) before cooling 
to the sensor read. The ground beacon navigation mode checks data good \4/ . 

If acceptable data is available, it then cycles to navigation sensor read. If there 
is no data good signal, either of three options are selected based on programmed 
logic: (a) continue tracking same beacon (b) select the next predicted beacon (if 
one is available) or (c) reenter the ground beacon prediction routine. 
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Figure 2- la. Functional Flow Diagram 















3. INPUT AND OUTPUT VARIABLES 


Input Variables 

p Specifies the current navigation mission phase 

tg Specifies when the given navigation phase (except entry) 

is to he initiated 


3 init 


Must be set to "l" on the first entry into the UNF program 
for each phase 


9 search Set to " l " an y time il is desired to initiate a search (for the 
target in rendezvous phases, visible UV horizon or ground 
beacons in orbit navigation phase) in any phase except entry. 
Set to ”1" on initial entry into UNF and thereafter if a ma- 
neuver may negate previous predictions, or break lockon 
to a target. 

s T Set to "l" if target state is to be included in UNF navigated 

state 


a beacon Set to 1 " ** ground-based sensors are used in a given phase 

3 pert Indicates type of gravity model to be used in Precis ion 

Extrapolation Routine 


s q Non-zero if process noise is to be included in W-matrix 

extrapolation 

q PN Process noise acceleration (if s^ = 1) 

Basic measurement loop cycle time (except phase 4) 

At & Accelerometer read cycle time (phase 4) 

r p*v p> tp Primary vehicle state and time tag 
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£.T — T ft T target vehicle state and time tag (phases 1, 2, 3) 

b Number of biases included in navigated state 


ng Total number of ground beacons available (phase 0) 


^tr, j 


Position vector (s) of ground beacons in earth-fixed coordinates 
(j - 1, 4. . . , 3ng-2) (pha3e 0) 


r 

—sun 


Sun position vector w. r. t. earth center (phase 0) 


0 


Azimuth direction of desired horizon measurement (phase 0) 


“tGB 
n rHS 


Number of orbital periods between W-matrix reinitializations 
for ground beacon, horizon sensing orbit navigation 


a zO ,t EF Angle between earth-fixed equatorial x-axis (through prime 
meridian) and reference equatorial x-axis at time tg^. 


t b bias estimates and time tag 

— DV Set *° M ^ M ^ velocity correction data is to be processed 

(phase 3) 


Avg Value of sensed Av to be processed if = 1 (phase 3) 

s rendW Set to "l" ^ automatic W-matrix reinitialization scheme 
is to be used (phase 1) 


If s renc iw = the additional inputs are required (de 

fined in nomenclature) 

*W' t maxW' S TPr 3 TPM' t bef' *ig' *Wcrit 

Earth radius at nominal touchdown point (phase 4) 

r TD Position vector at location of nominal touchdown point in 

earth-fixed coordinates (phase 4) 
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Vehicle mass (phase 4) 


Output Variables 

Updated primary vehicle state and. updated time tag 
( NOTE: In phase 3 output £p. Vp are relative state vectors) 

Updated target vehicle state and updated time tag (phases 1, 2 , 3). 

Relative state in local vertical coordinates (phase 3) 

Vehicle velocity w.r. t. touchdown point (phase 4) 

Vehicle velocity w.r.t. air mass (phase 4) 

Position vector from touchdown point to vehicle (phase 4) 


Updated bias estimates and time tag 
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DESCRIPTION OF EQUATIONS 


The detailed flow diagrams of the UNF program {Figures 5-1 to 5-20) con- 
tain the equations and logic required to perform the navigation functions of the 
shuttle on-orbit and entry, approach and landing phases. (Where subroutines are 
■hailed, the appropriate reference is shown which contains the flow diagrams and 
equation description for that particular function). The purpose of this section is to 
explain those equations and the logic flow which are not essentially self-explana- 
tory, or are not apparent from the discussion of the functional flow diagram. (Sec- 
tion 2) . 

Some general comments are in order before proceeding to the details of the 
flow diagrams. There are basically two sets of state vectors and time tags in- 
volved: permanent ones (£p, Vp, tp, — T’ *T ' anc * their temporary 

counterparts used in the UNF filter (^^^ » *xP^* * n cer *ain instances the 
temporary state may be advanced considerably beyond current time (e. g. in a 
ground beacon search) and it is obviously desirable to leave the permanent state 
prior to current time (e. g. maneuvers may be performed between the time of search 
initiation and beacon intercept). In addition, a permanent bias state (£g) is re- 
quired in order to allow different biases to be estimated when new navigation phases 
are initiated. The continuing advancement of the temporary state is accomplished 
by cycling to entry point ^ . Advancement of the permanent state is accomplished 
by cycling; to entry point ^ . 



4 . i State and W-matrix Extrapolation 

All navigation phases except entry (p ■ 4) utilize the Precision State and Filter 
Weighting Matrix Extrapolation Routine. The entry navigation phase takes a separate 
path as indicated in Figure 5-1 to the accelerometer read block. After correcting 
the sensed velocity change <Av g ). if accelerometer biases are estimated (t.e 
s =1). the entry phase flow cycles to entry point W where the Rapid Real-Time 
State Advancement During Specific Force Sensing Routine is utilized to advance t e 
primary state to the accelerometer read time t^ (This routine requires the gravi- 
tational acceleration < £ > from the previous time cycle. For the initia pass £ is s 
to the null vector (Figure 5-1) which indicates to the routine that the previous g 
must be calculated before integration is started.) 

For the non-entry navigation phases, vehicle state(s) and W-matrix (if re- 
quired) are extrapolated to the time t M which represents either: (a) the initia 
start time t £ , (b) measurement time, (c) time at which next horizon measuremen 

is predicted (state at this time is used to point horizon sensor) or (d) time 
which primary state is precision extrapolated to begin ground beacon search. 

Figure 5-2a and 5- 2b present the equations and logic for accomplUhing precision 
state (primary state in phases 0, 1. and 2, target state in phases 1. and 3) a 
W-matrix extrapolation. (Primary state extrapolation is also performe a 
first entry into the UNF for the station-keeping navigation phase (p * in or er 
synch the target and primary states to form the initial relative state. 


The logic and equations of Figure 5-2 determine the following: 

(a) When the W-matrix is extrapolated. 

The variable d % is set equal to the current dimension if 
W-matrix extrapolation is required, the dimension size 
indicating to the extrapolation routine the proper number- 
ing of the W- matrix. 

W-matrix extrapolation is not performed (indicated by 
d^ ■ 0 ) if either: 

• first entry into a given phase - 1 )* since 

the W-matrix will subsequently be initialized 

• a search is to be performed (no need for cur- 
rent W-matrix) 

• a second vehicle is extrapolated in the current 
time step and this state is not included in the 
navigated state estimate (s T = 0) (the W-matrix 
has already been extrapolated with the other ve- 
hicle state) 
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(b) Proper numbering of W-matrix in Extrapolation Routine. 

This is indicated by the variable k (if, of course, W-matrix extra- 
polation is required (d x 0 ) ). When k = 0, the primary state 
portion of the W-matrix is extrapolated. When k - 6 + b, the 
target state 6 x d submatrix is extrapolated. For phase 3, 
the k = 0 setting corresponds to the vehicle state portion of 
the W-matrix (this is extrapolated along the target state in 
this phase). 

The extrapolation of the relative state in phase 3 is accomplished using the 
transition matrix defined as follows: |^RR ^RV j . The equations required for 

this extrapolation are derived by linearizing differential gravity between the pri- 
mary and target vehicles, and are presented in Figure 5-3. If a velocity correc- 
tion (Av ) has been made which is to be incorporated in the estimated state (in 
— s 

the UNF), the switch is set to "l" and Av is incorporated as shown at the 

JJ V "—a 

bottom of Figure 5-3. 

The extrapolation of the W-matrix during the entry phase is accomplished 
using the Rapid Real-Time W-Matrix Advancement During Specific Force Sensing 
Routine (Ref. lb) . In order to save computer time, it may be possible to extra- 
polate the W-matrix at a slower rate than the state (studies are in progress to de- 
termine if any appreciable degradation will result). The logic for phase 4 W-matrix 
extrapolation is presented in Figure 5-14. If the W-matrix is to be extrapolated 
every (pre-loaded constant) accelerometer read cycles (At^), a running count 
(n^ t ) is maintained of the number of read cycles between W-matrix extrapolations 
and is compared to n w . The gravity matrix (G) corresponding to the previous time 
to which the W-matrix has been extrapolated is required as an input to this extra- 
polation routine. G is calculated in the UNF only for the first entry into phase 4, 
thereafter it is obtained as an output from the routine to be used as an input in the 
next extrapolation cycle. 
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4. 2 Search Modes and Navigation Sensor Reads 

For the non-entry navigation phases, a search mode is included in the UNF. 
Its function is either: 

(a) Initiate a rendezvous sensor search to achieve target lockon. 

An initial pointing vector (along the estimated relative posi- 
tion vector) is made available from the UNF at time tg for 
use in the rendezvous navigation phases (p - 1, 2, 3) 

(b) Predict the time of the next visible UV horizon. (Horizon 
sensing orbit navigation mode) 

(c) Predict time(s) of first visibility of ground beacons (ground 
beacon orbit navigation mode). 

A search mode is initiated by setting the switch s 3earch to "l". This is done for 
all non -entry phases upon the first entry into the UNF, and is again set to "l" when 
a ground beacon search is to be reinitiated,, or the time of the next visible UV 
horizon pass is to be predicted (e. g. , at the end of the current UV horizon pass). 

The logic at the top of Figure 5-4 determines which of the search functions 
(a, b or c above) is appropriate. Search function (a) is selected for rendezvous 
phases, and upon receipt of good sensor data, the rendezvous sens or (s) and mea- 
surement time t M are read (at entry page 5-21) n M is set to the number of 

measurement parameters, meas urem ent identification codes (c^) are appropriately 
set, and the flow cycles back to \l/ where states and W-matrix are extrapolated 
to time t M in preparation for measurement incorporation. 


4-4 



Search function (c) is selected for the ground beacon orbit navigation phase 
(p = 0, a b eacon = 1)* Ground beacon prediction is initiated at entry (page 5-8), 

and will be discussed in Section 4. 2. 2. 

4,2.1 Horizon Sensing Orbit Navigation 

Figures 5-4 and 5-5 present flow diagrams for visible UV horizon predic- 
tion (search function (b)), horizon sensor pointing equations (to provide inputs to 
attitude control system), and horizon sensor read. If s aearc h has been set to "l u 
(as described above), the primary vehicle state and time tag, the sun position vec- 
tor (r ), and the desired horizon azimuth (preloaded value of 0) are used in a 
—sun 

UV Horizon Prediction Routine (TBD) to predict the time t^y when the next visible 
UV horizon will occur. A time interval is allowed to pass (if tjjyis greater than 
current time plus one minute) until current time is one minute prior to t^y . 

^search set to zero to bypass horizon prediction on the subsequent cycles, s att 
is set to one to prepare for horizon sensor pointing, and is set to one to in- 

dicate the start of a visible UV horizon pass). The permanent vehicle state vector 
is then extrapolated to time t^y (by setting t M = t^jy and s perm = 1> by cycling 
back to entry V/ . This search mode is recycled prior to each visible UV horizon 
pass (i.e., once every rev). 

After the horizon search mode is completed, the following sequence is re- 
peated for each navigation measurement: 

(1) Precision extrapolate primary vehicle state to the predicted 
measurement time tj^ 

(2) Compute estimated horizon direction vector and call attitude 
control system to point horizon sensor in that direction 

(3) If data good, read horizon sensor output and measurement 
time t M 

(4) Precision extrapolate primary vehicle state and W- matrix 
to time tj£ in preparation for measurement incorporation 

(2) in this sequence is specified by setting the switch s ^ to "l” . (4) is specified 
by setting s tt to "O'*. With the search completed ( s search = 0) and s att - 1, the 
flow in Figure 5-4 branches to the Horizon Direction Routine which is presented 
in Figure 5-20. The inputs required by this routine are: £, the unit vector in 
the vehicle local horizontal plane directed toward the pre -scheduled horizon azimuth 
given by p ; ^ > the un it vector normal to the horizon measurement plane (defined 

by £ and vehicle position vector); Xq , primary vehicle position vector. The prin- 
cipal output is the vector from the primary vehicle to the horizon (£jj)- The 
angle £ (elevation angle to horizon) is also supplied if needed by the attitude control 
system to point the sensor. 
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The equations shown in Figure 5-20 for computing the direction of the horizon 
are derived in Bef. 10 and will be described briefly here. Assuming that the hori- 
zon is at a constant altitude above the earth's surface, the intersection of the mea- 
surement plane with the horizon is approximately an ellipse. (The exception to this 
is when the measurement plane coincides with the earth's equatorial plane (|c| of 
Figure 5-20) and the intersection becomes approximately a circle. For this 
special case the flow branches as shown in the figure and the distance to the hori- 
zon (Ojj) along with are computed quite simply as indicated.) The orientation 
of this horizon ellipse is defined in terms of three mutually orthogonal unit vectors: 

i _ , which is normal to the ellipse, i and i defined as shown in Figure 
— o — x — y 

4-1. Referring to Figure 4-1, it is clear that i and _i coincide with 

— x y 

the semi -major and semi- minor axes of the horizon ellipse, respectively. The 
plane containing the horizon ellipse is inclined with respect to the earth's 
equatorial plane by an angle whose sine is. ( _i * J. ^ ). 

The shape of the horizon ellipse is determined by the lengths of its 
major and minor axes. Assuming the contour of the earth to be well- approxi- 
mated by the so-called Fischer ellipsoid, the semimajor axis of the horizon 
ellipse (ajj) is simply the sum of the semimajor axis of this ellipsoid and the 
constant horizon altitude Likewise, the semiminor axis (b^) is found by 

adding the horizon altitude to that value of the radius of the Fischer ellipsoid which 
corresponds to a latitude equal to the inclination angle. 

The problem of determining the horizon location is readily solved in the hori- 
zon coordinate system for which the x and y axes coincide with the directions 
^i x and jl^ , respectively, as illustrated in Figure 4-2. The matrix will serve 

to transform vectors from the reference coordinate system to the horizon system. 

The two possible horizon locations are obtained by solving simultaneously 
the equation of the horizon ellipse 



and the equation of the line tangent to the ellipse and passing through the point 

°h , Eg 
2 h 2 

®H b H 


= 1 
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Figure 4-2. Geometry of Horizon Measurement 
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The horizon elevation angle ( £ ) is used to select the desired solution for the hori- 
zon location position vector in horizon plane coordinates (r^ ). Of the two solu- 
tions, the one in the direction of £ (i. e. , f < ff/2 ) is the desired horizon location. 

The vector from the primary vehicle to the horizon is then obtained by subtracting 

H (H ) 

the vehicle position vector (r ) from r H , and transforming the result from hori- 
zon coordinates to reference coordinates to achieve the desired output. 


It should be noted that the equations used in the Horizon Direction Routine 
make the assumption that the horizon measurement plane passes through the earth's 
center, or equivalently, the horizon sensor "scan axis" is normal to the vehicle 
position vector (vertical scan). This assumption will not cause significant errors 
for scan axis deviations from vertical that are less than approximately one degree. 
However, if it becomes desirable (or necessary in order to save attitude maneuvers 
or utilize more than one sensor simultaneously) to utilize a non- vertical scan, 
equations only slightly more complicated than those described above will be re- 
quired. (These equations have been developed for use in a CSDL environment model 
for shuttle orbit navigation simultations). 


After computing the horizon direction vector, a check is made to see if this 
vector intersects an assumed visible UV horizon (continuing the flow in Figure 
5-5 ). Referring to Figure 4-3 , the visible UV horizon starts 10 degrees off the 
terminator. If the angle between the sun vector (r ) and the estimated horizon 
location position vector (_i g), i» e. , h^ , is within the visible UV horizon region 
(h^ < s^), the attitude control system is called on to place the sensor boresight 
axis within the field of view of the horizon direction unit vector (_i g),and the scan 
axLs normal to the estimated vehicle position vector (Xq). (If £ H does not inter- 
sect the visible UV horizon, i. e. , h^ > s^ , the signal flow joins the no data good 
path fiescribed below). When current time has reached computer time (t x pK the 
horizon sensor data good signal is checked. If the data is good, the horizon sensor 
output is read (the angle between the sensor boresight and the sensed UV horizon) 
along with the measurement time . n^ is set to 1, indicating a single mea- 
sured parameter, C q is set to 3 indicating the angle me asurement type (0 ) , s atfc 
and 9 atrt 3X61 set to "0" and the flow cycles back to \l/ for state and W-matrix 
extrapolation to time t^ . (Sequence (4) discussed above. ) If no data good signal 
is received (a -qqq = OK either of two options is exercised: (a) if a new visible UV 
horizon pass is forthcoming (indicated by s gtrt . = 1 which is set following the 
horizon search), the assumption is that the visible horizon has not been reached yet 
and the predi cted measurement time t^j is incremented by 30 sec. The flow cycles 
back to entry for a repeat of sequence (1) through (3)j (b) if horizon sensing 
of a visible UV horizon has been in progress (indicated by iS 3trt 1 = 0), the assump- 
tion is that the visible UV horizon has ended. Thus, the pre-stored horizon azimuth 
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Unshaded area of earth assumed to include visible 


UV horizons 

r g s horizon location position vector 


Figure 4-3. Visible UV Horizon Geometry 



(0) for the start of the next visible UV horizon pass is read, and a new horizon 
searc h wil l be initiated (by setting s searc h = D after the state is extrapolated via 
entry \^/ . The extrapolation interval is set to 20 minutes which will allow suf- 
ficient time prior to the next visible UV horizon for the range of proposed shuttle 
orbital altitudes. 

4. 2. 2 Ground Beacon Orbit Navigation 

Figure 5-6 presents the flow diagram for ground beacon prediction. In a 
ground beacon orbit navigation system, a network of ground beacons (transponders) 
will be strategically located on the earth. The locations of these beacons, repres- 
ented by position vectors in earth-fixed coordinates (r + ^ , ), will be stored in a 
list (k s 1,4,,,, 3n^-2) in the on-board computer. The function of the ground beacon 

prediction routine is to (a) provide an estimate of the times (tr, * ,t„ . . ,t« ) 

i X Xj t £ f ^ 

that the shuttle will be in viewing" range of the next ground beacon and all subse- 
quent beacons within the current search interval (1/2 orbital period), and (b) 
specify, from the input list of beacon coordinates, the order in which these beacons 
come into view (using an identification code: i DB j.ipg 2 ♦ * * ji DB g*' 

The basic approach embodied in the prediction scheme of Figure 5-6 is as 
follows: 

Within a given search interval (r/2: 1/2 of an orbital period), the shuttle 
state is extrapolated conically in 1 minute steps. At each step, all of the stored 
beacon locations are examined for visibility except: (a) those beacons already 
identified as visible in a previous 1 minute step within the search interval or (b) 
when a beacon passes the visibility criterion, none of the beacons following that 
one on the input list need be examined in a given 1 minute step. (A beacon is 
"visible" to the shuttle when the shuttle position vector lies within a cone about 
the beacon as illustrated in Figure 4-4 ). If no beacons are found visible in a t/ 2 
search interval, the shuttle state (Xq) is precision extrapolated over the time in- 
terval t/ 4, at which point the search is reinitiated for the next r/2 search interval. 

If a visible beacon (or beacons) has been found within a r/2 search interval, the 
search is terminated provided no beacon is visible within 15 minutes of the last pre- 
dicted visible beacon (in order to assure a beacon overlapping (or closely spaced) 
to the last one is not overlooked when a new search is initiated. ) Figure 4-5 
illustrates the search sequence discussed above. Conic extrapolation of the shuttle 
state is utilized during a r/2 search interval in order to save computer time. This 
"conic search" interval is constrained to be half of an orbital period, with search 
reinitiation occurring a quarter of a period from the previous search initiation 
(after precision advancing the shuttle state) in order to minimize the error resulting 
from the conic extrapolation. . 5 


4-11 



Figure 4-4. Beacon Visibility Constraint 
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4-13 


Referring to Figure 5-6 , there are three basic loops involved in this flow 
diagram: 

(1) the outer loop which increments time (t ) in 1 minute steps over 

. con 

the Tf 2 search interval (or further as discussed above and illustrated in Figure 

4-5 (b)). The dummy state vectors (r_ . v ) are returned in the Kepler Routine 

—con —con 

in order to preserve the precision state (x Q , x 3 ) at the start of the search. The 
transformation matrix from earth fixed to reference coordinates is re- 

quired to transform the stored beacon coordinates (if analyses indicate the simple 
computation of M EF R shown is not accurate enough, a "Geodetic to Reference 
Coordinates Routine" (TBD) will replace this computation). 

(2) The "j loop" which "picks" one beacon at a time from the pre- 
stored list of beacon coordinates to checked for visibility at each value 

^ jfh beacon is visible, the time ^ con is stored as tg (the predicted 
time of intercept of the gth beacon found visible in the given tf 2 search interval), 
*DB,g is set e< * ual to J and serves as the identifying code for the gth beacon, and 
tg is set equal to t CQn indicating the time of intercept of the most current beacon 
found in this search interval. 

(3) The inner "k loop" which compares all possible beacon identification 
codes (ijjg j^) with the number j (indicating the jth beacon on the pre- stored list) 
and eliminates from the visibility check the jth beacon if it has already been identi- 
fied. 

As mentioned previously, the search is terminated when a i/ 2 search inter- 
val is completed with at least one beacon found visible and no visible beacon has 
been found within 15 minutes of the last predicted visible beacon. The program 
then cycles to entry (Figure 5-7). 

The first predicted visible beacon is then selected to be interrogated. The 
beacon coordinates are identified by igg . where i (set to "l" initially at the start 
of each search interval -Figure 5-6 ) indicates the number of beacons that have 
been selected from the total number (g-1) of predicted visible beacons (in the last 
search). The predicted time of intercept of the currently selected beacon (t-) is 
set equal to tg i and the current beacon coordinates (earth fixed) are designated 
£g n . (The current value of i is reserved using the d umm y variable i since i 
is used elsewhere as an index. ) When current time is at least 10 minutes prior 
to tg, the currently selected ground beacon is interrogated and the return signal 
awaited. When the data good signal appears (s^q = 1), the navigation sensor out- 
put is read along with the associated time t M , the measurement identification codes 
are set to indicate a range and range rate measurement and the number of mea- 
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sured parameters (n M > is set to 2. The program then cycles back to entry \y 
for precision state and W-matrix extrapolation to time t M - (Again, note that if a 
search has just been completed ( s searc h = is necessary to set s p erm to 1 

so that the extrapolation variables will be initialized since a continuous extrapola- 
tion is not being performed— the temporary vehicle state has been extra " 

polated during the search and the permanent state (£p*£p) must now be extrapolated). 

Ground Beacon "No Data Good" Logic 

The remainder of the flow diagram (Figure 5-7 ) contains the logic which 
determines which of the following options is selected following a no data good 
signal: 

Option (1): continue interrogating the same ground 

beacon every 30 sec. 

Option (2): select the next beacon from the list of 

visible beacons predicted in the previous 
search 

Option (3): start a new beacon search 1 minute 

from current time 

In this logic, it is assumed that for the currently proposed shuttle missions and 
the ma ximum range constraint on the sensor (1500 n. mi, ), the m axim um time for 
the shuttle to traverse a beacon visibility cone is about 10 minutes. 

Option (1) is selected under the following conditions: 

• If current time t^ is less than the predicted 

time of intercepting the current beacon (t p ). 

The assumption is that the actual beacon 
visibility cone has not been reached yet or 

• If there are no more visible beacons available 

from the previous search (or if another is 
available, it will not be encountered in less 
than another minute i, e. t^< t p - + ^ ~ 1 
minute), and t B < t c < t p + 10 minutes. The 
assumption is the predicted tg is inaccurate 
or the current beacon transponder is temporarily 
malfunctioning -thus keep interrogating it for the 
assumed maximum traverse time. 
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Option (2) is selected if there is another visible beacon available from 
the previous search (i f g) and: 

• The previous beacon has been interrogated for the 

maximum traverse time,. provided of course 
current time has not progressed to within 1 
minute of the next predicted beacon intercept 
time (tg ), in which case option (2) will 
immediately be taken , only if 

• Current time has not progressed past the pre- 

dicted intercept time of the next beacon plus 
the maximum traverse time. This condition 
: could be violated with overlapping beacon visi- 
bility cones, wherein the time consumed navi- 
gating over the previous beacon placed the 
shuttle out of the next beacon 1 s visibility cone. 

In this case the index i (indicating the number 
of. beacons selected in the current sequence) 
is incremented by two, and if there is yet an- 
other visible beacon available, option (2) is 
still selected. 

Option (3) is selected when no more visible beacons are available from 
the previous search interval. 

The ground beacon, prediction scheme discussed in this section may not 
be the one ultimately coded when the final beacon network has been established. It 
does, however, represent a "brute force" approach which is not overly expensive 
in computer time. Typically, a half orbit search should take approximately 10-15 
seconds assuming that a computer comparable to the Apollo Guidance computer is 
utilized. 


4. 2. 3 Entry Phase Sensor Read Logic 

As noted earlier in the discussion of Figure 5-1 , after reading the ac- 
celerometer outputs, the entry phase navigation flow cycles to entry ^22^ (Figure 
51“ 12) for extrapolation of the shuttle state to the accelerometer read time t^. 

After computing orbital altitude (h), vehicle velocity with respect to air mass (v ), 

r 

and the transformation matrix (as discussed earlier, if a more accurate 

computation of is required a "Geodetic to Reference Coordinates Routine 

will be written), the logic for determining which navigation measurements to pro- 
cess follows in Figures 5-12 through 5-16. 
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The navigation measurements considered here are drag, baro- altimeter 
altitude, range and azimuth from VOR/DME, and range, azimuth and two elevation 
angles from the MLS. Associated with each of these 8 measurement types, except 
the drag acceleration measurement which is derived from the accelerometer out- 
puts (Av g >, is a data good signal represented by the switches s^ i (i = 1, 2. . . 7). 
The first possible measurement is drag acceleration which is not incorporated 
until the vehicle altitude (h) is less than a given threshold value , typically 

about 200,000 ft). Thus the accelerometers are read and the vehicle state extra- 
polated every At a seconds without navigation updates until the altitude threshold 
is passed. (This threshold is then doubled to assure the h lNE)R threshold is always 
passed thereafter despite a possible navigation update which might change the esti- 
mated altitude appreciably. ) 

Drag measurements (identified as such by setting Cq = 5) are incorporated 
thereafter until the altitude threshold value (h FINDR , typically about 100, 000 ft) 
is reached. (The switch s xD is then set to "l" and altitude thresholds are no 
longer checked. ) 

After the first altitude threshold tojNDR* has been passed each of the other 
navigation measurement data good signals are checked. If any measurement passes 
data good (s,-^ . = 1), its corresponding sensor output is read, the measurement 
identifying code (c^ is appropriately set, and the number of measurements to be 
incorporated (n M > in a given time step is incremented by one. There are, however, 
additional constraints which must be met before incorporating baro- altimeter 
measurements: (a) vehicle altitude must be between an< ^ ^FBAR* 

vehicle velocity must not be in a specified region near Mach 1. 0 as indicated by 
speed switch levels v R jjj and v R ^g . (Figure 5-1 3a). 

Analyses have shown the desirability of reinitializing the filter weighting 
matrix (W -matrix) upon (1) first receipt of a VOR or DME measurement (which- 
ever comes first), and (2) first receipt of an MLS measurement (whichever of 
the 4 possible types comes first). The " first pass” for a VOR or DME measure- 
ment is indicated by the switch s fpQ , and for MLS measurements, s fpl . Provi- 
sion is made for different W -matrix initializing values in these two cases by use 
of the factors kg and k^, respectively, which scale the W-matrix values used 
initially on entrance into the entry phase. After a ’’first pass" has been indicated 

the switch s. is set to "1" and specifies W-matrix initialization as shown in 
fp 

Figure 5-14 . 
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Once an MLS measurement data good has been received, VOR/DME mea- 
surements are no longer accepted. Inhibiting VOR/DME under this condition is 
achieved by setting the switch s xTAC to "1" as shown in Figures 5-13b and 5-13c. 

Finally, if no "good" measurement data is available (indicated bvn„ = 0) 

J JVI 

the accelerometer output is read after a time interval (At a >, and the cycle repeated. 
With one or more "good" measurements available, the flow cycles to Figure 5-14 
where either W- matr ix initialization is specified (by s^ - 1 or s.^ = 1 ) and per- 
formed at entry * or W-matrix extrapolation to time t-^j is performed (dis- 

cussed in Section 4. 1) and the flow proceeds to entry 

4, 3 W -matrix Initialization 


Scheduling of W-matrix initializations for non-entry phases is contained 
in the flow diagram in Figures 5-8 and 5-9 . (The relatively simple W-matrix 
initialization schedule for the ent ry phase was discussed in Section 4. 2. 3. ) This 
section of the flow diagram ( ) is entered as shown at the top of Figure 5-8 

after state and W-matrix extrapolation to the measurement time t^ associated 
with a navigation sensor read. If a particular navigation phase has been entered 
for the first time (s init = 1), W-matrix initialization (entry V7 ) is specified 
immediately. Since no W-matrix reinitializations are required during automatic 


braking or station- keeping navigation phases (p = 2 and 3) after the initial entry 
intothese phases, the remaining flow in Figures 5—8 to 5-9 jg bypassed to entry 
. (This is also true of the rendezvous phase (p - 1), if analyses show W- 
matrix reinitiali 


reinitializations are not required, indicated by s __ = 0. ) 

J rendW ' 

For the orbit navigation phase (p = 0), W-matrix reinitializations are speci- 
fied to occur periodically after every n T orbital periods, (analyses to date indicate 
that recommended values for n r are: 1-1/2 periods for ground beacon orbit naviga- 
tion (indicated by n^Qg) ^d 5 orbital periods (indicated by h^gg) for horizon sensing 
orbit navigation). Thus, t is first computed and is compared with the product n t 
to determine if W-matrix initialization (entry ^ ) is to be performed or bypassed T 
(entry ). V 


W*ni8trix reinitializations are to be performed in the rendezvous navi- 
gation phase (indicated by s rendW = D* the flow branches to entry where 

the logic for scheduling these reinitializations is contained (Figure 5*9 ). There 
are two basic branches in this logic indicated by the switch s Tp jj that for pre- 
TPI (Terminal Phase Initiation Maneuver) navigation, and post-TPI navigation. 
After the TPI maneuver is performed, s Tpi is set to one, and W-matrix initializa- 
tion is performed prior to incorporation of the first navigation measurement 
following TPI and the first midcourse correction. Each pf these W-matrix re- 
initializations is triggered by the switch s TpM , which is' set to "1" following ex- 
ecution of TPI and the first midcourse maneuver. 
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The approach underlying the pre-TFI W-matrix reinitialization logic shown in 
Figure 5-9 is as follows: 

• A reinitialization is specified whenever the total 

time (At^.) that the current W-matrix has been 
extrapolated exceeds the stored threshold value 

t W * 

• The reinitialization will then be performed only 

if the following conditions are met: 

(a) A sufficient time (t^. exists prior to 

the final targeting computation time 
(estimated as a nominal pre-burn time 
interval (t^^) prior to planned maneu- 
ver execution time (t. 1 ). 

(b) A time interval (> 5 min) has not existed " 

prior to the currently planned navigation 
update in which no navigation updates 
have been made. If this condition is not 
met, the specified W-matrix reinitializa- 
tion is performed after 3 more navigation 
updates have been incorporated (controlled 
by the switch s count ). 

• An upper limit (t max ^) is placed on the total time the 

W-matrix may be extrapolated without a reinitializa- 
tion. (The conditions (a) or (b) could preclude re- 
initializations for an excessive time). If this limit 
is exceeded, a reinitialization is immediately per- 
formed. 

The threshold value t ^ is selected so that reinitializations are specified 
more often than actually required (because of modeling errors), but the conditions 
(a) and (b) minimize any degrading effects from the slight transient in performance 
caused by a reinitialization. This is a conservative approach which guards against 
making navigation updates with a W-matrix which seriously misrepresents actual 
state errors, a condition which is difficult (if not impossible) to predict with any 
degree of accuracy, and which can produce highly deleterious effects on navigation 
performance. 
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W-matrix initialization is presented in the flow diagram in Figure 5-10 
(and additionally in Figure 5-11 if correlation is inserted). For phases in which 
the W-matrix represents a relative state covariance matrix (s T = 0 and p = 1, 2, 3), 
W-matrix initialization consists simply of zeroing the matrix components, and in- 
serting a pre- stored position value in the three position components and a pre-stored 
velocity value in the three velocity components of the W-matrix diagonal, and bias 
values in the appropriate diagonal elements. This procedure is the same for the 
initial W-matrix (s.^ = 1) as well as for subsequent reinitializations, with different 
pre-stored W-matrix values used in these two cases. 

Two variations in this '’standard” W-matrix initialization procedure are 
incorporated for phases in which vehicle inertial state covariance matrices are used. 
The first involves pre-loading reduced values of crosstrack position and velocity 
components for incorporation into reinitialized W-matrices. (Once resolved, cross - 
track errors experience only small secular growth and thus do not require W-matrix 
values as large as those used for in- plane errors). Another possibility allowed for 
when reinitializing the W-matrix is retaining the crosstrack position, velocity and 
associated correlation in the W-matrix (indicated by input s^TW s ^ anc * 
some process noise in the crosstrack channel compensate for any smlLl modeling 
errors in this component. The reinitialization values are thus pre-loaded in local 
vertical coordinates (indicated by setting switches 9 LVWp ^ S LVWT^ 
this "local vertical” diagonal matrix must be transformed to reference coordinates 
as shown in Figure 5- 10b. 

The second variation involves inserting correlation into the initialized 
diagonal W-matrix. This variation was found to be particularly effective in re- 
ducing large state error growth rates experienced with diagonal W-matrix initiali- 
zations in ground beacon navigation, where long periods exist (between beacon in- 
tercepts) with no navigation updates. (Note: This approach may also be used in a 
rendezvous navigation phase in which both vehicle inertial states are estimated 
(s^, = 1). Each vehicle state covariance matrix may be initialized with correlation). 

The technique used for producing a correlated W-matrix initialization 
(Ref. 11) is contained in the flow diagram in Figure 5-11. This technique takes 
advantage of the fact that orbital energy and angular momentum magnitude are 
known on board to a higher degree of accuracy than other orbital parameters (e. g. 
downrange position), and certainly more accurately than is implied by a diagonal 
W-matrix. This information is inserted into the W-matrix in a straight forward 
manner. Pseudo energy and momentum measurements (called pseudo since no 
actual measurement is made, indicated by setting the switch s ^y corr "l". and 
only the diagonal W-matrix is updated) are incorporated into the pre-loaded diagonal 
W-matrix using the standard measurement incorporation equations (v ia^e ntry \3l/ . 
Pre-loaded a-priori values of energy and momentum variances (c* E , ) are 

utilized at the initiation of orbit navigation. At subsequent W-matrix reinitializa- 
tions, smaller values for these variances are used since these uncertainties will 
be diminished after the initial navigation period. This is accomplished (Figure 
5 - 10b by setting the variable tj to ”1” for the initial W-matrix initialization and to 
k(a^) for subsequent initializations .to scale the initial measurement variance 
appropriately downward. 


4-20 



4.4 


Bias Extrapolation 


Figure 5-15 presents the flow diagram for advancement, to measurement 
time t^j, of the bias components of the navigated state and their associated parti- 
tion of the W-matrix. If the sensor bias parameters to be estimated are modeled 
as invariant with time, this portion of the flow is bypassed by setting the input bias 
time tag tytO zero. If a time variation is modeled, the b x b bias transition matrix 
is computed to advance the bias state and bias partition (see Figure 1-2 ) of the 
W-matrix from the previous bias time t^ to the current measurement time t^ . 

Since the ultimate sensor models have not been firmly established, the explicit 
computation of is not shown; but the bias extrapolation equations utilizing 
are given in Figure 5-15 . 

4. 5 Measurement Incorporation 

Figures 5-16 through 5-18b present the flow diagrams for incorporation 
of the current set of measurement data at time t^ into the navigated state and W- 
matrix. The first two figures (5-16 and 5-17 ) involve some preliminary computa-- 
tions, and Figures 5 -18a and 5-18b present the equations for the actual navigation 
update. 

4.5.1 Computation of Relative State and Sensor 
"Axes" (Figure 5-16T 

As discussed in the introduction, navigation measurements for any of the 
mission phases fall into the category of "relative" measurements (range, range 
rate, angles (0, 6) ) with two exceptions in the entry phase -altitude and drag mea- 
surements. (The equations of Figure 5-16 are bypassed for these two measurements, 
indicated by their measurement codes (c. = 4 and 5, respectively) being greater 
than 3. ) For each relative measurement, a relative state is required for subse- 
quent measurement incorporation equations. Thus, for each navigation phase, the 
appropriate relative state (r , v ) is computed, e. g. the rendezvous target or 

i k 

ground beacon state w. r. t. the primary vehicle state. In the horizon sensing mode, 
only the relative position of the horizon w. r, t. the primary vehicle is required (p^) 
with no need for relative velocity. In the station -keeping phase (p = 3), the relative 
state is equivalent to the navigated vehicle state vector (x^.x^), and thus requires 
only redefinition to r^, v^ . 
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For any angle measurement (l<c^ < 4), a basic set of sensor "axes” (unit 
vectors jL x , , _i z ) is required for subsequent computations as discussed in the 

Introduction (see Figure 1-3 ). In a rendezvous phase (p = 1,2 or 3), the sensor 
axes are the rows of the transformation matrix ^ from reference coordinates 
to sensor gimbal axes, which is computed using current IMU angles (yield orienta- 
tion of inertial platform w. r. t. navigation base) , and matrices describing orienta- 
tion of inertial platform w. r. t. reference coordinates and orientation of navigation 
base w. r. t. sensor gimbal axes. Sensor axes for the other navigation phases are 
computed as defined in Figure 1-3. 

Several additional details should be noted before leaving Figure 5-16, 
There are two different angle measurement types (azimuth and elevation) in MLS 
terminal navigation, which are modeled as a single measurement type (angle 0 in 
Figure 1-3 with measurement code c ^ = 2). The sensor "axes" are defined ap- 
propriately to reflect the difference in these angles. To differentiate between the 
two angles, the azimuth angle code (c^) is set at 20 after the navigation sensor read 
(Figure 5-13b), causing the switch s to be set to "1" (see c. > 10 logic discussed 
in Figure 5-16 ). This switch setting then selects the proper equations for defining 
the sensor axes in the entry phase (p = 4) branch of the diagram. Also, the mea- 
surement code is divided by 10 to yield the proper code indicating a "0 type" angle 
measurement. 

Included in the ground beacon orbit navigation branch ^^ eacon s 1, p ^ 4) 
is the logic for determining if crosstrack navigation updates should be inhibited. 
This criterion is based on studies which determined, as a function of altitude, the 
angle between the orbital plane (£ is a unit vector normal to the plane) and the 
beacon position vector (r^), below which degraded crosstrack navigation perfor- 
mance results if crosstrack updates are accepted. If crosstrack updates are to be 
inhibited, the switch is set to "1" and only the in-plane components of the vehicle 
state are updated for the current measurement (Figure 5-18a>. 

4.5.2 Computation of Measurement Geometry Vector 

~~b (d x 1). Measurement Residual (Aq), and 
Sensor Variance ( a 4) (Figure 5-17 ) 

Measurement incorporation into the navigated state (x) and the W- matrix 

2 ~ 
requires b and or for each measurement type. Also required for the state update 

is an estimate of the measurement (q‘) which, when subtracted from the actual ith 
measurement (q^, yields the desired measurement residual (Aq). These para- 
meters are computed as shown in Figure 5-17 for each of the seven possible mea- 
surement types discussed in the Introduction. 
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The code c^, which is set after each navigation sensor read to identify the 
ith measurement at the current measurement time t M , determines the appropriate 
path for computing b,q* and ot ^ used to incorporate the ith measurement. Follow- 
ing these computations, the bias measurement geometry vector ( associated 

with the ith measurement is computed. For the horizon sensing mode, the horizon 
altitude uncertainty is assumed to be the bias estimated and its associated "b vec- 
tor” is the scalar (-l/r^ ) as shown. The biases estimated in the other navigation 
phases have not been firmly established as yet and this computation is therefore 
represented by the defining relation for the bias "b vector”. The intermediate 
variable y is then converted to appropriate components of the general d x 1 mea- 
surement geometry vector (b). The previously computed measurement estimate 
(q*) is then corrected to include the effect of the extrapolated measurement bias 

Xg 

estimate * 1 ) > ' from which the desired measurement residual (Aq) is then computed. 

Several items in Figure 5-17 should be noted. The expressions used for 
the angle measurement estimates (q 1 for c. = 2 or 3) were formulated as shown to 
avoid computational inaccuracies associated with dot products of vectors separated 
by an angle close to zero degrees. Also included in the angle measurement branch 
is logic to avoid the sign ambiguity between the actual measured angle ^q.) and the 
estimated angle (q 1 ) near angles of 180 degrees. 

In the drag measurement branch (c. - 5), certain quantities have a bar 
ova: them (p, & c> v^> which is used to indicate average values over the time in- 
terval t^ - At a to t^. Also, the computation of the actual drag measurement (q^ 
is included, which unlike the other measurement types, is not directly available 
from a navigation sensor read but must be computed from the accelerometer out- 
put (Av_) as shown. 

4. 5. 3 Incorporation of Measurement in the State 
and W -matrix (Figures 5-18a and 5-lSK ) 

These equations are written to accommodate any state (and W-matrix) 
dimension (d), which is a function of the number of biases included in the navigated 
state of a given phase, and depends on whether the target state is included in the 
navigated state (indicated by s T ). After computing the weighting vector (cc), the 
primary vehicle crosstrack components of tc are deleted, if required, as indicated 

/\ y 

by = 1 (discussed in Section 4. 5. 1), and the navigation update (^ d — ^) is com- 
puted. Provision is made for a "mark reject” procedure (TBD) which will check 
the "acceptability" of the ith measurement update (Ax). If unacceptable, the flow 
cycles to entry for incorporation of the next measurement (if available) at 

the current measurement time t^. 
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If Ax is acceptable, the flow -continues to entry \3 ij in Figure -5 -18b.. The 
sign of Ax is reversed in the station- keeping phase (p = 3) because of the standard 
definition used for the relative state (target vehicle— primary vehicle), coupled 
with the fact that this relative state is updated directly in this phase as opposed 
to updating the primary vehicle state in the other phases). Variables required for 
W-matrix reinitialization in the rendezvous phase (if s ren( jw = 1) a-re then updated 
prior to applying the navigation update (Ax) to the current state estimate (x). 

Permanent state variables (rp,Vp,tp,yg and r^.v^ if included in x) are 
updated by setting them equal to the temporary state <x). The variables (6p, Vp, 

J5rp, ) are also updated (if their associated state has been updated) for those 
phases using the Precision Extrapolation Routine (p - 0,1 or 2), and the relative 
state in local vertical coordinates (r L> v^) is updated for the station -keeping phase. 
Finally, the d x d W-matrix is updated as shown to reflect incorporation of the 
ith measurement. 


4. 6 Program Recycling or Termination (Figure 5-19) 

The logic shown in Figure 5-19 determines which of the following options 
is to be selected following incorporation of the ith measurement at time t^j ; 

(a) Incorporate the i + 1th measurement at time 

If the running count (indicated by i+1) of the number 
of measurements incorporated is not equal to the 
total number of measurements (n^) available at 
time t^, the next available measurement is incor- 


porated via entry 


1 ■ 


(b) Exit the UNF to the program sequencer. If all 

measurements at time have been incorporated 
and the current time exceeds any stored event 
times^ or one of the cues announcing entrance into 
a new phase is received (examples of cues given 
in Figures l-4a and l-4b), the UNF program is 
exited to a main "program sequencer" which then 
selects the appropriate function to be performed. 

Cycle back to the start of the UNF (entry \l/ ) 
program to prepare for incorporation of naviga- 
tion measurements at the next time t^ . 


(c) 
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(c) Cont'd. 


The entry phase (p = 4) waits until current time t ^ equals the previous 
measurement time t^ plus an increment At^, increments the W-matrix extrapola- 
tion cycle counter n^ t , and cycles to entry \1^ . 

The horizon sensing mode reads the next scheduled horizon azimuth ( $ ), 


increments t M by At M§ and proceeds to 


M’ 


v 


for an attitude maneuver check (indicated 


by setting = 1) prior to the next sensor read. 

After waiting until current time equals the next planned measurement 
time (t^ + At^), the ground beacon orbit navigation mode cycles back to entry 
\jl 5/ to check sensor data good, and the rendezvous phases (p = 1,2, 3) read the 
navigation sensor before cycling to entry . 
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5. DETAILED FLOW DIAGRAMS 


This section contains the UNF detailed flow diagrams which are discussed in 
detail in Section 4. 

Each input and output variable in the subroutine call statements can be followed 
by a symbol in brackets. This symbol identifies the notation of the corresponding 
variable in the detailed description and flow diagrams of the called routine. When 
identical notation is used, the bracketed symbol is omitted. 
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Figure 5-1, UNF initialization. Detailed Flow Diagram 
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Figure 5-3. Detailed Flow Diagram, Relative State 
Extrapolation (Station-Keeping Phase) 
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Figure 5-4. Detailed Flow Diagram, Search Mode Selec- 
tion, UV Horizon Prediction 


-19 


5-5 












N^lO/r^ 

TYes 



v t C < *xP 


Wait time in- 
tervalt^jp-tc 


Call Attitude Control System which uses 
i (or 0 & £) to place sensor boresight 
aJcis (x M ) within sensor FOV of _i , and 
s e ns oTr "scan axis" normal to x Q . 

If maneuver executed, set s = 1. 


Read Navigation Sensor and Time 
Output: q Q <angle between and 

trUe -ipH ) ' t M 



~\~strt 

Ties 

t M = t M + 30 sec ^ 


Read 0 for 
start of next 
sunlight pass 


3 search ~ 1 
t M = t xP + 20min 


Figure 5 


"k =r 

«v perm ^ 




S7 Figure 5-2/ 
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Figure 5-6. Detailed Flow Diagram. Ground 

Beacon Prediction (Orbit Navigation) 
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Figure 5-8. Detailed Flow -Diagr am, W-Matr;x Initialization 
Scheduling (Orbit Navigation) 
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Figure 5-9. Detailed Flow, Diagram, W- Matrix Initialization 
Scheduling (Rendezvous Navigation) 
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Figure 5- 10a. W-Matrix Initialization. Detailed Flow Diagram 
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Figure 5- 10b. W- Matrix Initialization. Detailed Flow Diagram 


5-12 






0 , 


<- . osa — 


‘Wcorr 


1 * °' s Wcorr ^ 1 

~~2 J 2 7 
a = <* E /n 

b Q = 4 unit(x 0 )/x 0 • x Q 
— 3 = —3 



Yeg < : ^r^ 

Y'No 

£ - unit{x q X x ^ ) 

a 2 - / n 

*0 = ^3 * i 
^3 = S. x 


!8rn = 0 


« iR i = umt(x 6+ b * *g+b> ~ 

Figure 5-15 . * g+b „ £ b g+b - C x x 6+b 


Figure 5-11. W -Matrix Initialisation (Adding Correlation), 

Detailed Flow Diagram 
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Figure 5-12. Detailed Flow Diagram, State Extrapolation 
and Drag Measurement Logic (Entry Phase) 
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Figure 5-13c. Detailed Flow Diagram, Entry Phase 
Sensor Bead Logic 
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Figure 5-14. Detailed Flow Diagram, W- Matrix Extrapola- 
tion and Initialization Logic (Entry Phase) 
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Figure 5-15. Detailed Flow Diagram, Bias and 
Bias W gu k Extrapolation 
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Figure 5- 18a. Detailed Flow Diagram, Measurement 
Incorporation into State and W- Matrix 







Figure 5- 18b. Detailed Flow Diagram, Measurement 
Incorporation into State and W- Matrix 
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Figure 5-19. Detailed Flow Diagram, UNF Program 
Recycling or Termination 
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Figure 5-20. Detailed Flow Diagram , Horizon 
Direction Routine 
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6. SUPPLEMENTARY INFORMATION 


The equations presented in this report are the results to date of studies per- 
formed under a G&C shuttle task to develop G&N equations for the on-orbit and 
entry- and -landing phases of the shuttle missions. The details of these studies may 
be found in a series of reports and memos listed in the periodically updated MIT/, 
DL Space Shuttle Task Summary Document (Ref. 2), in NASA G&C Division Space 
Shuttle Task Review Memoranda, and Refs. 12 through 17 for station -keeping 
analyses. 

The UNF formulation represents a design which is fundamentally sound, so 
that updates from the continuing navigation studies can be expected to require only 
minim al changes to the equations presented here. The design has been made flexi- 
ble enough so that most modifications can be absorbed by appropriate changes to the 
input variables. Areas currently under investigation which fall in this category are: 

(a) Determination of appropriate measurement biases to 

be estimated (all phases). 

(b) Desirability of estimating target state, and if desir- 

able, examine requirement for W- matrix reinitializa- 
tions (rendezvous phase). 

<c) Advancing W- matrix at lower than measurement rate 
(entry phase). 

(d) Determine schedule of horizon azimuths, schedule of 

W-matrix reinitializations, and requirement for process 
noise (horizon sensing orbit navigation). 

(e) Desirability of using relative state formulation in auto- 

matic braking phase (if desirable, this phase simply 
becomes part of the station -keeping navigation phase). 

Known areas in which equations need to be formulated are as follows: 

(a) UV horizon prediction routine 

(b) Automatic "mark reject" routine 

Areas in which equations may need to be formulated are as follows: 

(a) Relative state formulation for the entry phase 

(if desirable)' 

(b) Bias transition matrix ($g ) and bias measure- 

ment geometry vectors (^) when final sensor 
models are established. 
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(c) Geodetic to Reference Coordinates Routine (if 

simple formulation presented proves unsatis- 
factory). 

(d) Horizon direction equations for horizon sensors 

operated in "non vertical scan" mode. 
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